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Abstract 

The  Uranus  mobile  robot  was  built  by  Carnegie  Mellon  University’s  Mobile  Robot  Lab  to 
provide  a  general  purpose  mobile  base  to  support  research  in  to  indoor  robot  navigation. 
As  a  base,  it  provides  full  mobility,  along  with  support  for  a  variety  of  payloads,  such 
as  sensors  and  computers.  This  report  details  the  design  and  maintenance  of  Uranus’s 
mechanical,  electrical,  and  software  systems,  and  is  intended  to  serve  two  purposes.  First, 
it  acts  as  documentation  for  the  robot.  Second,  it  offers  a  perspective  in  to  mobile  robot 
design,  showing  the  decisions,  tradeoffs,  and  evolution  that  are  involved  in  the  design  of 
a  system  of  this  complexity.  Hopefully,  others  building  similar  systems  will  be  able  to 
profit  from  our  experience. 
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1  History 

The  Mobile  Robot  Laboratory  was  formed  in  1982  when  Hans  Moravec  came  to  Carnegie 
MeUon  from  Stanford  to  continue  his  research  in  to  mobile  robot  navigation  and  robot 
evolution.  The  first  goal  of  the  lab  was  to  build  a  small  indoor  mobile  robot  on  which 
various  navigation  experiments  could  be  performed.  To  this  end  we  designed  and  began 
building  our  first  mobile  robot,  Pluto  (see  Figure  la).  We  envisioned  Pluto  as  the  ultimate 
indoor  robot  within  the  grasp  of  current  technology.  Its  small  cylindrical  body  (about  80 
cm  in  diameter  and  1  meter  tall)  was  omni-directional  with  three  degrees  of  freedom:  at 
any  given  moment,  it  could  move  in  three  directions,  forwards/backwards,  sideways,  and 
rotation,  or  any  combination  of  the  three.  For  instance,  it  would  be  able  to  move  in  a 
smooth  arced  trajectory  while  rotating  about  its  center.  This  omni-directionality  combined 
with  very  precise  positioning  would  allow  Pluto  to  easily  maneuver  in  a  cluttered  indoor 
environment.  Since  Pluto  could  position  itself  in  any  orientation,  it  would  also  allow  us 
to  mount  a  robot  arm  on  top  of  Pluto,  but  forgo  the  heavy  and  power  hungry  shoulder 
joint  that  is  typical  of  such  manipulators.  To  achieve  omni-directionality,  Pluto  used  three 
wheel  assemblies.  Each  wheel  assembly  consisted  of  a  pair  of  differentially  connected 
wheels,  and  two  motors  to  independently  drive  and  steer  the  wheel  pair.  Each  of  the  six 
motors  was  controlled  by  its  own  dedicated  microprocessor.  These  six  microprocessors 
were  in  turn  controlled  by  a  single  computer,  the  conductor,  which  orchestrated  the  motion 
of  each  motor  to  achieve  the  desired  robot  motion.  An  additional  computer  interfaced 
the  conductor  via  a  wireless  communications  link  to  external  mainframe  computers,  on 
which  the  navigation  algorithms  were  run.  All  power  to  Pluto  was  provided  by  on  board 
batteries. 

Unfortunately,  the  lofty  goals  of  Pluto  turned  out  to  be  more  than  our  small,  inexperi¬ 
enced  group  could  handle,  and  a  number  of  problems  kept  Pluto  from  becoming  the  robot 
of  our  dreams.  The  wheels  were  too  small,  and  the  differential  pairs  could  easily  get 
stuck  on  rough  surfaces.  The  six  independently  controlled  motors  were  over  constrained 
by  the  three  avtiilable  degrees  of  freedom  on  the  floor,  so  it  was  possible  for  the  motors  to 
“fight”  each  other,  attempting  to  stretch  the  floor.  The  motor  drivers  were  unreliable,  and 
due  to  the  design  of  the  robot,  hard  to  maintain.  These  and  other  problems  became  much 
more  difficult  than  we  had  tinticipated,  and  thus,  while  all  of  the  individual  components 
of  Pluto  worked  reasonably  well,  they  never  came  together  as  a  smoothly  functioning 
mobile  robot.  While  a  few  control  experiments  were  performed  on  Pluto,  it  was  finally 
retired  to  the  Boston  Computer  Museum  with  other  early  robots.  But  Pluto  was  certainly 
not  a  wasted  effort;  we  learned  a  lot  about  the  requirements  and  realities  of  building 
mobile  robots,  and  now  we  were  ready  to  do  it  right. 

Meanwhile,  while  we  were  learning  how  not  to  build  a  robot,  the  computer  scientists 
who  wanted  to  do  navigation  research  were  complaining  about  the  lack  of  a  vehicle. 
Thus,  in  1985  we  built  Neptune  (Figure  lb),  a  quick  and  dirty  mobile  robot,  in  three 
months.  Neptune  is  the  opposite  extreme  of  Pluto:  we  kept  it  as  simple  as  possible. 
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Figure  1:  Early  mobile  robots:  (a)  Pluto  with  single  camera  on  slider,  (b)  Neptune  with 
ring  of  sonar  sensors. 

Basically  a  remote  controlled  platform  for  carrying  various  sensors,  Neptune  is  a  three 
wheeled  tricycle  with  two  motors:  one  for  driving  and  one  for  steering.  The  motors 
are  synchronous  AC  motors  which  run  at  a  fixed  speed:  they  are  either  on  or  off.  The 
only  position  feedback  from  the  motors  is  a  micro  switch  indicating  if  the  steering  wheel 
is  centered.  Power  and  communications  are  via  an  umbilical  cable.  There  is  only  a 
single  computer  on  board,  which  takes  high  level  motion  commands  via  a  serial  port  and 
attempts  to  execute  them  by  turning  the  motors  on  and  off  for  appropriate  time  intervals. 
Despite  all  of  its  limitations,  Neptune  still  works  reliably,  and  has  been  used  for  a  wide 
variety  of  navigation  research. 

2  Introduction  to  Uranus 

With  Neptune  completed,  we  again  looked  at  our  original  objective:  a  small,  powerful 
mobile  robot  capable  of  autonomous  indoor  navigation.  In  1986,  we  began  construction 
of  our  third  mobile  robot,  Uranus'  (Figure  2).  Like  Pluto,  Uranus  is  battery  powered  and 
can  move  precisely  with  three  degrees  of  freedom  on  the  floor.  Unlike  Pluto,  Uranus 
works  quite  well. 

Uranus  is  about  60  cm  wide,  75  cm  long,  and  40  cm  tall  (without  sensors),  and 
weighs  about  50  kg.  Its  most  unique  and  striking  feature  is  its  wheels,  which  give 
the  robot  its  three  degrees  of  freedom.  These  wheels  were  designed  by  the  Mecanum 
company  of  Sweden  for  use  in  wheel  chairs,  and  perform  ideally  for  a  robot  of  this  size. 
The  circumference  of  each  wheel  is  lined  with  rollers  set  at  45  degrees  relative  to  the 
main  wheel  axis  (see  Figure  3).  For  a  pair  of  wheels,  the  rollers  on  each  wheel  are  set  in 


'To  avoid  endless  bad  puns,  we  pronounce  it  UR-ah-nus. 


Figure  2;  Uranus. 


opposite  directions.  When  both  wheels  of  a  pair  are  driven  in  same  direction,  motion  in 
the  rollers  is  cancelled,  so  the  pair  will  move  forwards  or  backwards  just  like  an  ordinary 
pair  of  wheels.  However,  when  the  wheels  are  driven  in  opposite  directions,  the  rollers 
will  act  like  a  screw,  and  the  pair  will  move  sideways.  With  four  of  these  wheels,  Uranus 
can  move  in  the  three  possible  directions  on  the  floor  simultaneously.  Note  that  this  is 
still  an  over  constrained  system  (four  motors  for  three  degrees  of  freedom),  but  it  is  an 
easier  control  problem  than  Pluto,  and  minor  position  errors  in  an  individual  motor  will 
simply  cause  a  small  amount  of  wheel  slip. 

Each  wheel  is  independently  shock  mounted,  and  is  driven  by  a  powerful  DC  brushless 
motor.  A  drive  train  of  gears  and  link  belts  connect  the  motor  to  the  wheel.  A  shaft 
encoder  is  coupled  directly  to  the  motor  shaft  to  provide  position  feedback  to  the  motor 
controller.  The  motor  driver  amplifiers  are  built  directly  into  the  motor  housing  to  provide 
adequate  heat  sinking. 

Mounted  on  the  same  level  as  the  wheels  and  motors,  two  sealed  lead  acid  batteries 
and  the  associated  switching  and  charging  circuitry,  provide  till  on  board  power.  Mounted 
on  the  level  above  this  is  power  distribution,  and  the  computer  card  cages.  These  consist 
of  two  5-slot  VME  bus  cages,  with  DC-DC  switching  power  supplies  providing  the 
appropriate  voltages.  Three  of  the  10  bus  slots  are  used  by  the  motor  servo  controller, 
the  rest  are  free  for  navigational  computing. 

The  top  of  Uranus  is  covered  by  a  thick  aluminum  plate  gridded  by  threaded  holes, 
allowing  any  type  of  sensor  or  other  experiment  specific  equipment  to  be  easily  mounted. 
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Figure  3:  a.  A  Mecanum  wheel,  b.  Wheel  configuration  on  Uranus. 


3  Uranus  Mechanics 

Uranus  is  constructed  entirely  of  anodized  aluminum.  The  robot  can  be  vertically  divided, 
both  conceptually  and  physically,  in  to  three  distinct  sections.  The  bottom-most  section 
contains  the  wheels,  motors,  and  batteries,  along  bulk  power  switching  and  charging 
functions.  The  middle  section  of  the  robot  contains  power  conditioning  and  distribution, 
and  the  on  board  computers.  These  two  sections  are  capped  by  the  top  plate,  on  to  which 
experiment  specific  equipment  can  be  attached. 


3.1  Bottom  Chassis 

The  bottom  section  is  built  from  four  3  inch  by  6  inch  rectangular  aluminum  tubes  with 
3/16  inch  thick  walls.  The  motors  and  wheel  suspension  are  mounted  to  the  two  side 
tubes,  with  the  drive  train  running  inside.  One  end  tube  houses  the  battery  charging 
circuitry,  while  the  other  houses  the  shore  power  connector  and  switches  for  main  power 
and  battery/off  board  power  selection.  A  battery  pan  mounts  in  the  cavity  formed  by  the 
four  tubes,  holding  the  two  batteries.  Each  of  the  side  tubes  can  be  removed  intact  with 
minimal  disassembly,  to  aid  in  motor  and  drive  train  maintenance. 

3.1.1  Wheels 

Uranus  is  built  around  four  Mecanum  wheels  (Figure  3a),  as  described  earlier.  These 
wheels  are  about  9  inches  in  diameter,  and  arranged  such  that  their  points  of  contact  with 
the  floor  form  a  perfect  square,  as  shown  in  Figure  3b.  The  square  configuration  is  not 
necessary  for  three  degree  of  freedom  motion,  but  it  does  make  the  control  equations 
simpler. 

In  this  configuration,  the  equation  relating  the  overall  vehicle  velocity  in  the  X,  Y, 
and  9  directions  given  wheel  velocities  of  Vq,  Vj,  14,  and  14  is: 


Vx  =  (Vo  +  Vi  + 14  +  14)74 


(1) 


Vy  =  (H  -  Ki  +  ^2  -  K3)/4 

Vg  =  (Vb  +  Vl -1/2-V'3)/4 
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(2) 
(3) 

Note  that  since  there  are  four  controllable  velocities,  there  is  a  fourth  independent  velocity 
term,  which  corresponds  to  stretch  in  the  floor: 

V;rTor  =  (Vb-  V,-K2  +  K3)/4  (4) 

This  term  is  always  servoed  to  zero  to  prevent  wheel  slippage. 

3.1.2  Motors 

Uranus  is  propelled  by  four  Inland  Motor  BM-3201  brushless  DC  synchronous  motors. 
The  rotor  has  an  8-pole  permanent  magnetic  field,  using  rare  earth  samariuni-cobolt 
permanent  magnets.  CoU  windings  in  the  stator  form  three  phases,  and  are  internally 
connected  in  a  three-leg  delta  configuration.  Each  motor  weighs  4  pounds  (excluding 
housing),  and  can  produce  650  ounce  inches  peak  torque.  We  used  these  particular 
motors  because  of  their  small  size  and  high  power  density,  and  also  because  they  were 
expensive  and  we  had  them  left  over  from  Pluto.  Their  primary  disadvantage  is  that  there 
are  no  commercial  controllers  available,  so  we  had  to  design  our  own. 

Each  motor  housing  is  machined  aluminum,  anodized  black,  with  built  in  heat  sink 
fins  (a  stalled  motor  can  draw  212  watts).  The  motor  driver  amplifiers  are  buUt  inside  the 
housing,  with  the  transistor  heat  tabs  bolted  directly  to  the  housing  case.  A  recessed  area 
in  the  housing  accommodates  the  shaft  encoder,  allowing  it  to  attach  directly  to  the  motor 
shaft.  Two  connectors  mount  to  the  top  of  the  housing,  one  for  motor  driver  power,  and 
the  other  for  digital  control  and  shaft  encoder  signals. 

3.1.3  Shaft  Encoders 

Each  motor  has  a  shaft  encoder  attached  directly  to  its  rotor.  This  shaft  encoder  provides 
position  feedback  for  the  motor  servo  controller.  The  shaft  encoders  are  BEI  Electronics 
Type  E25  1024-count  incremental  optical  encoders.  The  LED  illumination  source  option 
was  chosen  for  ruggedness  and  long  life.  The  internal  circuitry  of  the  encoders  is  CMOS 
for  low  power  consumption  (125  mA  typical).  The  outputs  are  dual  quadrature,  with 
index,  which  can  be  decoded  by  the  interface  circuitry  into  an  absolute  position  with  a 
resolution  of  4096  counts  per  motor  revolution. 

On  the  Pluto  robot  we  had  used  more  inexpensive  two  piece  encoder  assemblies.  We 
experienced  numerous  problems  with  drifting  alignment  and  disk  breakage,  due  to  lower 
tolerances  in  the  motor  design.  These  BEI  shaft  encoders  are  self  contained,  sealed  units, 
and  are  attached  to  the  motor  rotors  via  compliant  helical  couplings,  eliminating  all  of 
these  problems. 
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Figure  4:  Drive  train. 

3.1.4  Drive  Train  and  Suspension 

The  drive  train  is  a  two-stage  mechanism  (Figure  4)  which  transfers  power  from  the 
motor  to  the  the  wheel  with  an  approximately  3:1  reduction,  and  also  provides  shock 
absorption  to  the  wheel.  It  is  mounted  inside  the  side  tube  of  the  bottom  chassis,  to  keep 
it  free  from  dust  and  away  from  wires.  We  used  the  W.  M.  Berg  Flex-E-Gear  drive  chain 
system:  the  gears  are  16A6  aluminum  sprocket  gears,  and  the  belts  are  16GCF  drive 
train  belts.  This  system  provides  a  strong,  light  weight  drive  train  with  little  backlash. 

The  motor,  inner  idler  gear,  and  pivot  gears  are  fixed  to  the  chassis.  The  motor  gear 
is  keyed  to  the  motor  shaft  to  prevent  it  from  slipping.  The  inner  idler  can  be  moved  up 
or  down  to  adjust  the  tension  on  the  inner  belt.  The  two  middle  gears  are  fixed  together 
around  a  single  bearing  at  the  pivot  point.  The  outer  wheel  gear  and  idler  mount  to  an 
arm  which  rotates  about  the  pivot  point.  The  outer  idler  can  be  moved  up  or  down  along 
the  arm  to  adjust  the  tension  of  the  outer  belt.  The  top  of  the  wheel  end  of  this  arm 
is  fixed  to  a  stiff  spring,  and  the  other  end  of  the  spring  seats  against  the  chassis.  This 
provides  the  suspension,  and  allows  the  wheel  to  ride  up  or  down  almost  an  inch.  The 
wheel  axle  is  fixed  to  the  outer  wheel  gear  and  pinned  to  prevent  the  wheel  from  slipping, 
but  still  allow  it  to  be  easily  removed. 

The  suspension  is  very  imponant  for  two  reasons.  First,  it  gives  the  payload  a 
smoother  ride:  although  the  robot  operates  in  an  indoor  environment,  there  are  still 
cables  and  door  thresholds  to  overcome.  Second,  it  keeps  all  of  the  wheels  in  contact 
with  the  ground  while  traversing  rough  or  uneven  terrain.  If  one  wheel  leaves  the  ground, 
the  motion  of  the  robot  is  unpredictable,  and  dead  reckoning  becomes  impossible. 

In  the  first  design  of  the  drive  train,  the  two  belts  were  non-standtird  lengths,  and 
we  built  them  by  hand  using  a  crimping  kit  from  Berg.  We  had  a  lot  of  trouble  with 
these  belts  breaking  at  the  crimp  point,  especially  when  the  robot  was  carrying  a  heavy 
load  (like  a  person).  The  geometry  of  the  idler  gears  was  changed  slightly  so  we  could 
utilize  standard  size,  machine  crimped  belts,  and  we  have  not  had  any  more  belt  breaking 
problems  (and  we  also  stopped  giving  joy  rides). 
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Figure  5:  Top  plate. 


3.2  Middle  Chassis 

The  middle  section  of  the  robot  is  built  up  from  .  .Juminum  plate,  which  attaches  to 
the  bottom  tubes.  Holes  in  this  plate  allow  access  to  the  battery  compartment  and  main 
power  feeds.  A  vertically  oriented  rectangular  tube  is  mounted  in  each  comer  to  support 
the  top  plate.  Emergency  stop  buttons  are  housed  in  these  tubes.  All  power  conditioning 
and  distribution  controls  are  mounted  on  the  two  side  panels,  supported  by  the  vertical 
tubes.  Connections  to  the  motors  run  out  of  the  side  panels  of  the  middle  section,  then 
down  directly  to  the  motors.  The  two  VME  bus  cages  mount  in  the  front  and  back  of  the 
middle  section.  Power  converters  for  the  processors  are  mounted  directly  to  the  cages, 
so  the  cages  may  be  removed  as  self  contained  units  for  testing. 

3.3  Top  Plate 

The  top  plate  is  1/4  inch  aluminum,  27  inches  long  by  23  inches  wide,  and  rides  about 
14.5  inches  above  the  floor.  It  is  bolted  to  the  tops  of  the  four  comer  venical  tubes 
of  the  middle  chassis.  There  are  rounded,  reinforced  slots  along  the  edges,  providing 
convenient  lifting  points  and  cable  routes.  The  plate  is  completely  gridded  with  1/4-20 
threaded  holes  on  one  inch  centers,  reinforced  with  steel  inserts. 


4  Electronics 

The  electronics  system  on  board  Uranus  is  divided  in  to  three  main  subsystems:  power 
generation  and  distribution,  interface  to  the  four  motors,  and  the  low  level  computers. 
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Figure  6;  Power  system  overview. 

4.1  Power 

Power  for  Uranus  is  provided  by  either  on  board  batteries  or  a  connection  to  an  off  board 
power  supply.  The  off  board  supply  can  both  completely  power  the  robot  and  charge  the 
batteries. 

Figure  6  is  an  overview  of  the  power  system  from  the  input  source  to  the  main  power 
connection  block,  where  power  is  distributed  to  the  rest  of  the  robot.  The  raw  power 
available  at  this  block  is  24  VDC,  and  may  drop  under  low  battery  or  high  load  conditions. 
6  gauge  stranded  wire  is  used  for  all  connections  between  the  inlet  and  batteries,  through 
the  selection  relay,  to  the  connection  block.  This  portion  of  the  power  system  resides 
in  the  bottom  section  of  the  robot  chassis,  with  the  connection  block  as  the  interface  to 
the  rest  of  the  power  distribution  system.  This  allows  the  bottom  chassis  to  be  detached 
from  the  middle  section  with  minimal  disassembly. 

From  the  main  power  connection  block,  power  is  distributed  to  the  motors,  computers, 
and  other  devices  requiring  power,  through  a  distribution  panel  in  the  middle  section  of 
the  chassis. 

Throughout  the  robot,  the  power  ground  is  kept  isolated  from  the  robot  chassis. 

4.1.1  Power  Selection  and  Switching 

The  power  selection  system  in  Figure  6  consists  of  a  relay  to  switch  between  on  board 
(battery)  and  off  board  (inlet)  power,  plus  the  main  on/off  switch  and  main  circuit  breaker. 
Figure  7  details  this  circuitry. 

Power  selection  between  battery  and  inlet  power  is  through  a  surplus  high  current 
DPST  mechanical  relay,  in  which  the  contact  blocks  and  wiring  were  redone  to  form 
a  SPOT  configuration.  The  relay  is  controlled  by  two  push  buttons,  wired  to  form  a 
self-holding  circuit.  A  small  DPDT  relay  powers  the  proper  indicator  light  and  is  also 
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Figure  7:  Power  selection  an(i  switching. 

used  by  the  self-hold  circuit.  Inlet  power  cannot  be  selected  when  it  is  not  present,  and 
disconnecting  inlet  power  will  automatically  switch  to  battery  power. 

The  output  of  the  power  relay  goes  through  the  60  amp  main  robot  circuit  breaker 
(ETA  41-3-S14-LN2),  and  then  the  main  power  toggle  switch.  The  toggle  switch  is  an 
aircraft  quality  high  capacity  switch  (Cutler-Hammer  8781K11)  which  can  switch  very 
high  DC  current  without  internal  arcing. 

All  of  the  low  current  switches  and  indicators  are  Cutler-Hammer  E22  series,  with 
custom  printed  labels  and  lenses. 

The  switches,  indicators,  small  relay,  and  circuit  breaker,  along  with  the  off  board 
power  inlet  (a  Lemo  S -series  type  RA5  2-pin  panel  mount  receptacle)  are  mounted  in  the 
front  tube  of  the  bottom  chassis.  The  selection  relay  is  mounted  near  by,  in  the  batterj' 
pan.  The  main  power  and  ground  wires  run  up  the  side  of  the  battery  pan  to  the  main 
power  connection  block  on  the  middle  section. 

4.1.2  Batteries 

On  board  power  is  provided  by  two  Globe  GelCell  U-128-HD  gelled  lead  acid  batteries. 
Each  battery  provides  12  VDC  with  31  amp  hours  of  capacity,  totaling  approximately 
3/4  kilowatt  hours.  Lead  acid  batteries  are  used  because  of  their  high  power  density  for 
the  size,  ruggedness  and  reliability,  simplicity  of  the  charging  circuitry,  and  long  lifetime. 
Figure  8  shows  the  details  of  the  battery  pack. 
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Figure  8:  24  volt  EX2  battery  pack. 

A  60  amp  DC  circuit  breaker  (ETA  41-3-S14-LN2)  is  positioned  close  to  the  battery 
terminals,  to  help  prevent  damage  in  case  of  an  accidental  short  of  the  main  battery  wires. 

The  batteries  are  mounted  on  their  sides  mount  in  the  battery  pan,  secured  by  a  plastic 
bracket.  The  terminals  face  inwards  to  keep  connections  lengths  short  and  protect  the 
exposed  portions. 

4.1.3  Battery  Charging 

The  first  battery  charge  on  board  Uranus  was  a  DC-DC  converter  driven  from  the  24 
VDC  off  board  inlet.  This  converter  produced  a  constant  28.8  volts,  which  was  fed  to  the 
batteries  through  a  current  limiting  resistor.  This  charger  worked,  but  had  the  unfortunate 
property  that  if  you  forgot  to  turn  it  off,  it  would  over-charge  the  batteries  and  eventually 
destroy  them  by  boiling  off  the  electrolytic  (which  can’t  be  replaced  in  a  gelled  type 
battery).  This  led  to  the  design  of  a  new  charger  which  could  be  reliably  left  hooked  to 
the  batteries,  switching  between  “charge”  and  “maintenance”  modes  automatically.  The 
new  charger  is  also  powered  from  wall  power,  to  keep  the  thickness  of  the  power  cord 
down. 

The  new  battery  charger  (Figure  9)  is  mounted  in  the  “rear”  tube  of  the  up  the  bottom 
section  of  Uranus.  Input  is  a  standard  DIN  style  AC  receptacle,  with  a  built  in  on-off 
switch  and  fuse.  The  charger  can  supply  a  maximum  of  five  amps  to  the  batteries, 
allowing  a  total  recharge  time  of  about  six  hours. 

The  charger  consists  of  two  parts;  the  charging  circuit  and  the  power  supply.  Due 
to  size  constraints  (space  in  the  tube  limits  the  size  to  about  3”  x  3”  x  7”)  a  traditional 
transformer  based  linear  power  source  could  not  be  used.  Instead,  a  high  efficiency  DC- 
DC  converter  is  used.  A  standard  DIN  style  power  cord  brings  120  VAC  to  the  250  Volt 
12  amp  full  wave  bridge  rectifier  with  a  47/iF  150  volt  electrolytic  capacitor  in  shunt  with 
DC  side  of  the  bridge  to  reduce  ripple.  This  is  fed  to  the  DC  to  DC  converter  (Vicor 
V1-L54-CU)  which  converts  the  165  VDC  to  the  ~28.8  VDC  needed  by  the  charger 
circuit.  Normally  the  converter  puts  out  48  VDC,  but  this  is  adjusted  by  setting  the 
20KQ  potentiometer  PI  to  approximately  11.6kI2. 

Charging  is  controlled  by  a  circuit  built  around  the  Unitrode  UC3906  charger  IC.  This 
chip  implements  a  three  stage  charging  sequence.  When  the  batteries  are  significantly 
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Figure  9:  Charging  circuitry. 

discharged,  the  charger  goes  into  bulk  charge  mode,  dumping  the  maximum  current  (Imax). 
five  amps,  to  the  batteries.  As  the  batteries  come  up  to  the  overcharge  voltage  (Voc)  of 
28.8  volts,  the  charger  enters  overcharge  mode,  which  maintains  the  batteries  at  Voc  until 
the  current  drops  below  the  overcharge  terminate  current  (loct)  of  0.5  amps.  At  Ioct»  the 
charger  goes  into  float  mode  which  it  will  maintain  until  one  of  the  other  two  modes  is 
triggered.  In  float  mode,  the  charger  holds  the  batteries  at  the  float  voltage  (Vf)  of  27.6 
volts.  LEDs  on  the  front  panel  of  the  charger  indicate  when  the  charger  is  on,  and  when 
it  is  in  overcharge  mode.  The  pertinent  equations  for  selecting  the  proper  resistances  are: 


Voc  =  2.3(\ +Ra/Rb  +  Ra/Rc)  (5) 

Vf  =  23{\+Ra/Rb)  (6) 

Imax  =  .25W/Rs  (7) 

loc.  =  .025V//?5  (8) 


4.1.4  Power  Metering 

The  power  metering  circuitry  (Figure  10)  displays  the  voltage  and  power  consumption  of 
the  robot  on  two  analog  meters.  The  meters  are  mounted  on  the  side  of  one  of  the  vertical 
comer  tubes  in  the  middle  chassis,  and  the  power  supply,  amplifier,  and  connectors  are 
built  on  a  perf  board  mounted  to  the  same  tube.  A  switch  turns  the  whole  meter  section 
on  and  off,  so  no  power  is  used  when  the  meters  are  not  needed. 
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The  voltage  is  measured  with  a  simple  30  volt  DC  meter  (Triplett  220-G).  Current  is 
measured  with  an  F.  W.  Bell  IHA-IOO  Hall  effect  current  sensor.  This  sensor  produces  a 
voltage  which  is  proportional  to  the  current  flowing  through  its  sense  coil.  The  sensor  is 
mounted  in  the  battery  pan  near  the  power  selection  relay,  and  the  main  power  feed  wire 
from  the  relay  to  the  power  connection  block  is  routed  through  the  sensor.  The  sensor 
output  is  amplified  by  a  simple  op  amp  circuit  which  feeds  a  5  volt  DC  meter  (also  a 
Triplett  220-G).  The  amplifier  gain  can  be  adjusted  so  the  scale  of  the  meter  (0  to  5 
volts)  corresponds  to  a  0  to  50  amp  current  range.  A  Pico  LRA15D  DC/DC  converter 
provides  +15  and  -15  volts  to  the  Hall  effect  sensor  and  the  op  amp. 

4.1.5  Power  Distribution 

A  switch  panel  on  the  left  side  of  the  middle  chassis  controls  power  distribution  from  the 
main  power  connection  block  to  three  main  branches:  computers,  motors,  and  auxiliary 
(Figure  11).  The  configuration  of  each  section  is  identical.  A  pair  of  momentary  contact 
buttons  controls  a  Crydom  D1D20  solid  state  relay  wired  in  a  self-holding  fashion:  the 
normally  open  button  will  turn  the  relay  on,  and  the  normally  closed  button  will  break 
the  connection.  The  relays  are  rated  for  20  amps  DC,  and  switch  the  main  24  volts  DC 
from  the  power  connection  block  through  an  ETA  45-700-P10-DD  10  amp  DC  circuit 
breaker.  Each  switch/relay  section  has  a  labeled  light  which  indicates  when  the  relay  is 
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energized.  The  buttons  and  indicators  are  Cutler-Hammer  E22  series  with  custom  printed 
labels. 

The  power  down  button  on  the  motor  branch  is  wired  in  series  with  four  other 
normally  closed  buttons.  These  are  the  four  large  red,  lighted,  motor  stop  buttons  -  one 
on  each  of  the  vertical  middle  chassis  tubes.  The  buttons  are  lit  when  the  motors  have 
power,  and  pressing  any  one  of  them  will  power  down  the  motors,  but  leave  the  rest  of 
the  robot  running.  The  motor  stop  buttons  are  Cutler-Hammer  A161  series  with  24VDC 
lamps  and  DC  rated  normally  closed  switch  contact  blocks. 

The  motor  power  branch  from  the  distribution  panel  does  not  actually  power  the 
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Figure  12:  Motor  power  (one  of  four). 

motors  (since  each  motor  can  potentially  draw  10  amps),  but  instead  powers  individual 
relay/circuit  breaker  combinations  which  feed  directly  off  the  main  power  block  (see 
Section  4.2.1). 

4.2  Motor  Interface 

Each  of  the  four  motors  is  electrically  interfaced  to  the  robot  through  two  connectors 
located  on  the  outside  top  of  the  motor  housing.  One  of  these  connectors  provides  power 
to  the  motor,  and  the  other  the  control  signals  to  the  driver  amplifiers  and  from  the  shaft 
encoders.  The  wires  to  these  connectors  are  bundled  and  shielded,  and  routed  through 
holes  in  the  side  panels  of  the  middle  chassis  to  their  appropriate  internal  connections. 

4.2.1  Motor  Power 

Power  is  applied  to  the  motors  via  a  push  button/relay  combination  on  the  power  distri¬ 
bution  panel  (Figure  11),  causing  the  Motor  Enable  signal  to  go  to  24  volts.  This  signal 
turns  on  four  individual  20  amp  solid  state  relays  (Crydom  D1D20),  one  for  each  motor 
(Figure  12).  Each  of  these  motor  power  branches  is  protected  by  a  10  amp  DC  circuit 
breaker  (ETA  45-7(X)-P10-DD),  the  rating  being  slightly  greater  than  the  maximum  motor 
stall  current.  The  relays  and  circuit  breakers  are  mounted  along  the  inside  of  the  right 
side  panel  in  the  middle  chassis. 
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The  relays  switch  raw  24  volts  from  the  batteries  to  the  motor  amplifiers,  since  no 
regulation  is  necessary,  but  high  current  is.  Along  with  the  24  volts,  two  regulated,  low 
current  voltages  are  also  supplied  to  the  amplifiers:  One  is  12  volts  above  the  ground  rail 
(0+12),  and  the  other  12  volts  below  the  positive  rail  (24-12).  Nominally,  these  signals 
will  both  be  at  12  volts,  but  as  the  battery  voltage  drops  due  to  discharge  and  load,  the 
24-12  volt  signal  will  also  drop,  maintaining  a  12  volt  differential.  It  is  this  differential 
that  is  necessary  for  the  amplifiers,  not  the  absolute  voltage  level. 

The  0+12  and  24-12  references  are  generated  by  standard  7812  and  7912  linear 
regulators,  with  l/xF  bypass  capacitors.  The  regulators  are  in  TO-220  packages,  and  the 
whole  regulator  assembly  (one  for  each  motor)  is  mounted  on  a  shelf  below  the  motor 
relays  and  breakers. 

The  power  connection  to  the  motor  is  through  a  Lemo  B -series  type  FHG  4-pin  right 
angle  plug,  wired  as  shown  in  Figure  12.  Ground  and  +24  volts  are  provided  through  14 
gauge  teflon  coated  wire,  and  the  0+12  and  24-12  references  are  through  24  gauge  hookup 
wire.  The  four  wires  are  bundled  in  a  braided  shield  to  help  reduce  amplifier  switching 
noise.  On  the  motor,  a  matching  Lemo  type  EGG  panel  mount  receptacle  terminates  the 
connection  and  brings  the  signals  through  the  motor  housing  to  the  amplifiers.  The  Lemo 
connectors  were  chosen  for  their  size,  reliability,  and  positive  locking  features. 

4.2.2  Motor  Amplifiers 

The  three  motor  windings  are  connected  internally  in  a  triangular  “delta”  configuration. 
To  turn  the  motors,  power  is  switched  to  the  three  legs  of  the  delta  in  a  specific  sequence. 
This  sequence  is  generated  by  the  servo  computer,  and  output  as  logic  level  signals  to 
the  motor  amplifiers.  It  is  the  motor  amplifiers,  one  for  each  leg,  which  switch  the  coils 
between  ground  and  24  volts  at  a  potentially  high  currents.  The  hookup  of  the  amplifiers 
to  the  coils  and  servo  computer  control  signals  is  shown  in  Figure  13.  A,  B,  and  C  are 
the  control  signals  from  the  servo  computer,  and  the  LEDs  are  part  of  the  opto-isolation 
circuitry,  described  later.  By  wiring  the  control  signals  in  this  fashion,  the  state  of  the 
amplifiers  is  dependent  on  the  relative  polarities  of  the  control  signals,  not  the  absolute 
voltages,  so  a  ground  reference  is  not  necessary  and  the  number  of  wires  is  minimized. 

Each  motor  amplifier  is  constructed  on  a  small  1”  x  2.75”  printed  circuit  board.  The 
three  amplifiers  for  each  motor  are  mounted  inside  the  motor  housing  with  stand-offs. 
The  four  power  devices  on  each  amplifier  are  in  TO-220  cases,  and  are  bolted  to  the  heat 
sinking  surface  of  the  housing  with  insulating  transistor  mounting  hardware.  Connections 
to  the  amplifiers  are  made  with  spade  lug  terminals  to  allow  them  to  be  removed.  The 
logic  signals  enter  the  housing  through  a  Lemo  B-series  12-pin  type  EGG  panel  mount 
receptacle,  which  is  shared  with  the  shaft  encoder.  Figure  15  shows  the  placement  of  the 
amplifiers  in  the  motor  housing,  and  the  connector  pin  outs. 

Figure  14  details  the  design  of  the  motor  amplifier.  The  logic  input  from  the  servo 
computer  is  isolated  from  the  rest  of  the  amplifier  circuitry  through  the  opto-isolator  OPl. 
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Figure  13:  Delta  configuration  wiring  of  the  motor  amplifiers  to  the  motor  coils  and  the 
servo  computer  control  signals. 

Resistor  RO  limits  the  current  to  the  opto-isolator.  Ignoring  the  time  delay  circuitry  in 
the  middle  for  the  moment,  transistor  Q1  acts  to  invert  the  input  to  the  FETl/2  pair,  and 
RIO  helps  attenuate  the  high  frequency  noise  in  the  high  gain  circuitry.  Depending  on 
the  polarity  of  the  input,  one  of  the  two  push/pull  FET  combinations  (FETl/2  or  FET5/6) 
will  turn  on,  turning  on  the  corresponding  power  FET,  which  switches  the  output  to  +24 
or  ground.  To  compensate  for  the  lower  current  carrying  capacity  of  the  P-channel  FET 
devices,  two  are  used  in  parallel  (FET3  and  FET4),  decoupled  by  Rll  and  R12.  The 
ultra  fast  recovery  rectifier  D3  avoids  the  problem  of  reverse  current  sharing  between 
these  two  FETs.  The  diodes  D2,  D5,  Zl,  and  Z2  act  as  gate  protection  for  the  FETs  on 
both  rails. 

One  problem  with  the  power  FET  devices  is  the  relatively  slow  switching  speed, 
especially  the  turn  off  time  of  the  P-channel  devices.  If  the  FETs  were  switched  in 
the  obvious  push/pull  fashion,  the  N-channel  device  would  turn  on  before  the  P-channel 
device  had  fully  switched  off,  resulting  in  a  momentary  dead  short  across  the  power 
rails.  This  will  create  a  huge  spike  resulting  in  noise,  reduced  power  efficiency,  and 
eventual  component  damage.  This  problem  is  solved  with  the  R/C  time  delays  R5/C3 
and  R6/C4,  and  the  voltage  comparator  ICl.  The  time  delays  are  chosen  to  match  the 
FET  characteristics,  and  the  comparator  outputs,  through  the  opto-isolators,  inhibit  the 
first  stage  FET  pairs  from  turning  on  for  a  fixed  time  after  a  polarity  switch. 

There  is  still  some  high  frequency  ringing  in  the  amplifiers.  A  220/iF  electrolytic 
capacitor  is  wired  across  the  power  and  ground  connections  of  each  amplifier  to  help 
reduce  this  problem,  and  the  amplifiers  function  adequately. 
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Figure  14:  Motor  amplifier  (one  of  three  per  motor). 

4.2.3  Shaft  Encoders 

Each  shaft  encoder  couples  directly  to  the  back  of  the  motor  shaft,  and  is  mounted  inside 
of  the  motor  housing.  Five  wires  electrically  interface  the  shaft  encoder  to  the  servo 
computer:  ground  and  power,  the  two  quadrature  signals,  and  the  index  signal.  These 
signals  exit  the  motor  housing  through  the  receptacle  shared  with  the  amplifier  control 
signals,  and  are  connected  as  shown  in  Figure  15.  Inside  the  motor  housing,  the  shaft 
encoder  wires  are  coupled  to  the  receptacle  with  a  flat  5-pin  Molex/Waldom  WM-72 
miniature  connector,  to  allow  the  shaft  encoder  to  be  easily  removed. 

One  problem  with  the  shaft  encoders  is  that  they  provide  a  relative  position  output, 
plus  an  index  pulse  once  per  revolution.  This  index  pulse  is  used  to  synchronize  the 
shaft  encoder  interface,  to  maintain  an  absolute  position,  which  is  required  to  properly 
commutate  the  motors.  Thus,  whenever  power  is  applied  to  the  shaft  encoders,  they 
must  be  spun  one  full  revolution  to  synchronize  the  interface.  This  is  usually  performed 
immediately  after  the  robot  is  powered  up  by  giving  it  a  small  shove. 

Power  to  the  shaft  encoders  must  be  regulated  -i-5  volts.  Instead  of  regulating  this 
from  the  motor  power  branch,  this  power  is  supplied  by  the  servo  computer  over  the 
signal  connector.  This  was  done  for  two  reasons:  it  was  more  convenient  and  did  not 
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Figure  15:  Placement  of  amplifiers  in  motor  housing,  and  connector  pin  outs. 

require  an  additional  voltage  regulator,  but  more  importantly  it  allows  the  shaft  encoders 
to  remain  powered  even  when  the  motors  are  shut  off.  The  motors  are  often  shut  off  to 
prevent  the  robot  from  accidently  colliding  with  an  obstacle,  and  if  the  shaft  encoders 
got  power  from  this  source,  they  would  need  to  be  reinitialized  each  time.  The  computer 
is  generally  turned  on  once  when  the  robot  is  powered  up,  and  left  turned  on. 

4.3  Computers 

Uranus  was  designed  to  carry  and  support  substantial  computing  power  on  board.  The 
computing  performs  two  basic  tasks:  low  level  motion  control  and  robot  maintenance 
(servoing  the  motors,  monitoring  robot  status,  communications),  and  high  level  navigation 
and  sensor/payload  specific  actions.  The  computing  support  resources  are  physically 
divided  in  two,  reflecting  the  separation  of  these  tasks. 

4.3.1  VME  Bus  and  Power 

Uranus  houses  two  5-slot  6U  VME  bus  card  cages,  occupying  most  of  the  space  in  the 
middle  section  of  the  robot.  The  front  panels  of  the  installed  cards  face  outwards  to 
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the  front  and  back,  with  the  back  planes  in  the  middle.  The  card  cages  were  assembled 
from  modular  components  made  by  Schroff.  The  VME  bus  was  chosen  for  the  wide 
variety  of  products  available.  The  back  planes  are  configured  in  the  standard  dual  wide 
fashion,  with  the  PI  and  row  B  of  the  P2  connectors  bussed  through,  and  P2  rows  A  anc 
C  left  open.  If  necessary,  the  card  cage  can  be  reconfigured  to  hold  10  single  wide  (3U) 
cards.  Two  small  fans  on  each  cage  force  air  through  the  cage  across  the  boards,  and  are 
turned  on  when  computer  power  is  applied.  Although  the  fans  are  quiet,  they  are  stiU  the 
noisiest  component  of  the  robot  during  operation.  Thermostatically  controlled  fans  were 
considered,  but  never  implemented. 

Power  to  the  back  planes  is  supplied  by  DC/DC  converters  mounted  on  an  aluminum 
bracket  between  the  two  back  planes.  With  minor  disassembly,  the  bracket  can  swing 
out  of  the  way  to  allow  access  to  the  P2  connectors.  24  volt  raw  power  to  the  converters 
comes  from  the  computer  branch  of  the  power  distribution  panel,  through  a  high  current 
diode  which  keeps  back  current  (from  the  still  spinning  fans)  from  holding  the  distribution 
relay  closed  when  the  power  down  button  is  pressed.  A  Vicor  VI-110  DC/DC  converter 
provides  +5  volts  at  15  amps,  and  two  Micro  Power  12  volt  converters  supply  plus  and 
minus  12  volts  at  1  amp  each.  Note  that  the  -t-5  volt  supply  is  also  routed  to  the  motor 
shaft  encoders  (Section  4.2.3). 

4.3.2  Servo  Controller 

The  workhorse  computer  on  board  Uranus  is  the  servo  controller,  whose  sole  function  is 
to  accept  high  level  motion  commands  (either  from  another  computer  or  a  joystick),  and 
properly  servo  and  commutate  the  four  motors  to  achieve  those  motions.  This  computer 
and  its  associated  interface  hardware  occupy  most  of  one  of  the  VME  bus  card  cages. 

The  first  controller  computer  used  on  Uranus  was  a  Force  CPU-IB,  based  on  a  8MHz 
Motorola  68000  microprocessor.  It  supported  128K  bytes  of  RAM,  128K  bytes  of  ROM, 
a  real  time  clock,  24  bits  of  parallel  I/O,  three  timers,  and  three  serial  ports.  This  was 
supplemented  with  a  second  VME  board,  a  Force  RR-1  battery  backed  memory  board 
with  an  additional  128K  bytes  of  RAM.  The  use  of  battery  backed  RAM  was  important 
as  it  allowed  downloading  control  programs  semi-permanently,  but  still  allowed  them 
to  be  easily  changed.  Although  several  servo  control  schemes  were  developed  on  this 
processor,  it  was  not  quite  fast  enough  for  the  amount  of  work  required,  and  it  could 
never  smoothly  control  the  robot’s  motion  without  some  oscillations.  This  was  mostly 
due,  we  believe,  to  the  speed  of  the  motor  commutation  -  the  lowest  level  and  most 
frequently  accessed  code. 

Software  for  the  Force  processor  was  developed  on  a  Digital  Equipment  VAX  mini¬ 
computer  using  a  C  cross-compiler  from  Stanford.  Compiled  and  linked  files  were  down¬ 
loaded  to  the  processor  memory  over  a  serial  line.  A  simple  ROM  monitor  allowed  basic 
processor  control  and  program  downloading.  A  basic  kernel  with  Unix-like  I/O  routines 
was  developed  to  simplify  programming. 
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In  1989  the  Force  computer  and  memory  were  replaced  with  a  faster  Dynatem  DCPU- 
30  computer.  On  very  nice  feature  of  this  board  is  its  CMOS  construction  and  hence, 
low  power  consumption:  less  than  5  volts  at  1  amp  when  not  accessing  the  bus.  The 
Dynatem  board  is  based  on  a  20MHz  Motorola  68030  microprocessor,  with  512K  of 
battery  backed  memory  on  board,  up  to  512K  bytes  ROM,  a  Motorola  68882  floating 
point  coprocessor,  four  serial  lines,  three  8-bit  parallel  I/O  ports,  a  real  time  clock,  and 
three  timers.  Due  to  the  faster  speed  and  on  board  memory  (minimizing  bus  access),  this 
board  can  successfully  run  the  full  servo  control  program  with  room  to  spare. 

Software  for  the  Dynatem  processor  is  developed  on  a  Sun-3  workstation,  using  the 
native  Sun  C  compiler  and  linker,  greatly  simplifying  the  programming  cycle.  A  simple 
kernel  was  evolved  from  the  Force  kernel  to  provide  a  Unix-like  operating  environment. 
We  have  considered  moving  to  a  commercial  real  time  kernel  such  as  VxWorks,  but 
have  not  done  so  due  to  the  stringent  timing  requirements  of  the  commutation  code. 
Downloading  is  again  done  over  a  serial  line,  using  a  simple  ROM  monitor. 

4.3.3  Motor  Interface 

All  interface  to  the  motors  is  through  a  single  VME  board  which  allows  the  processor 
to  read  the  shaft  encoders  and  write  the  motor  control  bits.  It  also  interfaces  to  the 
joystick,  providing  current  the  joystick  position.  The  interface  was  custom  designed  for 
the  motors,  and  is  constructed  with  wire-wrap  technology  around  a  Xycom  XVME-085 
VME  prototyping  module.  The  XVME-085  provides  all  of  the  glue  circuitry  to  interface 
as  a  memory  mapped  device  to  the  VME  bus,  along  with  a  large  prototyping  area,  greatly 
simplifying  the  design.  The  interface  is  electrically  connected  to  the  motors  and  shaft 
encoders  through  the  P2  connecter.  A  socket  on  the  back  side  of  the  back  plane  brings 
these  signals  off  the  bus  to  four  9-pin  Molex/Waldom  WM-72  connectors,  one  for  each 
motor,  mounted  on  the  power  supply  bracket.  Connection  to  the  joystick  is  through  a 
DB9  connector  on  the  front  panel.  The  front  panel  also  contains  two  LEDs  which  show 
the  state  of  the  interface.  Schematics  for  the  interface  are  in  Appendix  A.  Sheet  1  shows 
the  shaft  encoder  and  motor  control  circuitry,  which  is  repeated  four  times  -  one  for 
each  motor  (the  notation  nn  specifies  the  motor  number,  in  binary).  Sheet  2  is  the  glue 
circuitry  to  interface  to  the  XVME-085,  and  sheet  3  is  the  analog-digital  converter  for 
the  joystick. 

Motor  PWM  There  are  two  control  signals  to  the  motors:  the  three  bits  to  the  amplifiers 
on  the  delta  coil  legs,  and  a  pulse  width  modulation  signal.  The  three  control  bits  are 
chopped  at  about  15KHz,  and  the  PWM  signal  specifies  the  pulse  width,  or  duty  cycle,  of 
this  chopping  -  from  0%  (completely  off)  to  100%  (completely  on).  The  control  bits  are 
latched  by  a  74HC173.  The  pulse  width  control  is  accomplished  with  an  Ixys  IXDP610 
bus  compatible  digital  PWM  controller,  which  can  be  programmed  for  0  to  100%  duty 
cycle  over  256  steps.  The  output  of  the  PWM  controller,  along  with  a  general  motor 
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disable  bit,  is  latched  with  the  control  bits  by  a  74HC11.  Finally,  the  bits  are  amplified 
by  a  push/pull  FET  combination  to  drive  the  amplifiers. 

The  motor  disable  bit  is  common  for  all  four  sections,  and  is  set  in  one  of  the  XVME- 
085  status  registers.  On  power  on,  it  comes  up  disabled,  and  must  be  programatically 
enabled.  The  status  of  this  bit  is  also  displayed  by  a  green  LED  on  the  front  panel  (lit 
when  motors  enabled). 

Shaft  Encoders  The  quadrature  shaft  encoder  outputs  are  decoded  by  a  Hewlett  Packard 
HCTL-20{X)  quadrature  decoder/counter.  It  internally  counts  with  16  bits  of  resolution, 
accessed  8  bits  at  a  time  over  the  bus.  Reading  the  high  byte  will  cause  the  low  byte  to 
be  internally  latched  (without  disabling  counting),  to  avoid  roll  around  problems  during 
the  read  cycle.  With  the  1024-count  shaft  encoder,  it  decodes  to  4096  counts,  or  12  bits. 

One  problem  with  the  HP  chip  is  that  it  has  no  provisions  to  clear  the  counters  with 
the  shaft  encoder  index  pulse  to  provide  absolute  position.  A  chip  reset  will  clear  the 
counter,  but  is  not  suitable  for  pulsing  once  per  revolution  since  it  will  clear  the  latch, 
and  could  potentially  occur  during  the  middle  of  a  read  cycle.  To  solve  this  problem,  the 
index  pulse  is  gated  with  a  zero-enable  signal,  and  is  enabled  for  resetting  under  software 
control  when  the  shaft  encoder  is  not  otherwise  being  read.  Because  the  number  of  counts 
is  a  power  of  two,  absolute  position  is  not  lost  during  roll  over  if  the  upper  4  bits  are 
simply  ignored.  This  scheme  seems  to  work  quite  reliably. 

Joystick  The  three  axis  joystick  provides  analog  signals  between  0  and  5  volts  related 
to  the  position  of  each  axis.  These  signals  are  multiplexed  by  a  4051  l-or-8  analog 
demultiplexer,  which  routes  the  selected  signal  to  a  National  ADC0803  A-D  converter. 
Note  that  there  are  5  unused  input  channels  on  the  demux,  which  can  be  used  for  other 
status  information,  such  as  battery  voltage  and  current  from  the  metering  circuitry. 


5  Servo  Control 

Because  the  servoing  and  commutating  of  the  motors  are  completely  under  program 
control,  it  is  easy  to  try  various  control  schemes.  On  the  other  hand,  the  effort  to  develop 
a  working  servo  controller  was  non-trivial,  and  many  times  we  wished  we  had  used 
commercial  controllers  that  had  already  solved  the  problems  we  discovered.  Figures  16 
and  17  show  a  pseudo-code  version  of  the  first  working  servo  controller  we  developed. 
This  controller  individually  position  servoed  each  wheel,  and  was  good  for  joysticking 
the  robot  around.  It  did  suffer  from  some  vibrations  and  oscillations  -  problems  that 
were  solved  in  later,  more  complicated  servo  algorithms.  New  algoithms  also  servo  the 
position  and  velocity  of  the  entire  robot,  not  just  the  individual  wheels,  which  helps 
simplify  the  navigation  software. 
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init_hardware 
makejphase_tables 
velocity [ 1 .. 4 ]  =  0 
error [1 . . 4 ]  =  0 
wake_up  =  0 
while  not  quit 

if  new  command  then 

set  new  velocity [1 .. 4 ] 
end  if 

if  wake_up  >  20  then  //  Every  10  ms 
for  w  =  1  to  4 

delta_p  =  curr_se[w]  -  last_se[w] 
last_se[w]  =  curr_se [w] 

err  =  error [w]  +  velocity [w]  -  delta_p 
err  =  clip (err,  -max_err,  +max_err) 
error [w]  =  err 
err  =  err  *  gain 
motor_dir[w]  =  sgn(err) 
motor_pw[w]  =  abs (err) 
next  w 
end  if 
end  while 


Figure  16:  Pseudo-code  representation  of  the  first  simple  position  servo. 


on  0.5  ms  timer  interrupt 
wake_up  =  wake_up  +  1 
for  w  =  1  to  4 

curr_se[w]  =  read_se (w) 
set_pw(w,  motor_pw[w]) 
if  raotor_dir[w]  =  forward 

then  set_coils (w,  f_phase_table [curr_se [w] ] 
else  set_coils (w,  b_phase_table [curr_se [w] ] 
end  i  f 
next  w 
end  on 


Figure  17:  Pseudo-code  representation  of  the  commutation  loop. 
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5.1  Servo  Loop 

The  servo  loop  comprises  the  main  program,  and  starts  by  initializing  all  of  the  hardware, 
and  setting  the  initial  velocity  and  error  terms  to  zero.  The  error  terms  track  the  total 
error  from  the  current  position  and  the  desired  position.  The  velocity  terms  are  the 
command  signal,  and  are  added  to  the  error  each  time  through  the  servo  loop  to  update 
the  desired  position.  The  velocity  terms  are  derived  from  the  inverse  of  equations  1 
through  4  (Section  3.1.1),  with  14,Tor  set  to  zero. 

Once  set  up,  the  servo  loop  mns  continuously.  It  first  checks  if  there  are  new  velocity 
commands,  and  if  so,  updates  the  velocitys.  It  then  checks  if  the  wake_up  counter 
has  reached  the  10  millisecond  mark.  Wake_up  is  incremented  each  time  through  the 
timer  driven  commutation  loop,  and  is  used  to  keep  the  servo  loop  and  commutation  loop 
synchronized  with  only  one  timer.  If  10ms  have  passed,  then  wake_up  is  reset  and  the 
servo  code  is  executed,  otherwise  it  loops  back  to  wait.  For  each  motor,  the  servo  code 
computes  the  change  in  position  from  the  last  time  through  and  this  time,  and  updates 
the  error  term  with  with  this  delta  and  the  command  velocity.  The  error  term  is  clipped 
to  prevent  excessively  large  jumps  and  multiplied  by  a  gain  factor.  The  sign  of  the  error 
term  is  used  as  the  command  to  the  commutation  loop  for  the  new  motor  direction,  and 
the  magnitude  of  the  error  term  is  the  pulse  width. 

5.2  Motor  Commutation 

It  is  the  commutation  loop  which  actually  manipulates  the  hardware,  reading  the  shaft 
encoders  and  writing  pulse  width  and  coil  energization  information.  The  commutation 
loop  is  called  via  a  high  priority  timer  interrupt  every  0.5ms.  It  first  increments  the 
wake_up  counter.  Then,  for  each  motor,  the  commutation  loop  reads  the  current  shaft 
encoder  position,  sets  the  desired  pulse  width,  and  depending  on  the  desired  direction, 
energizes  the  proper  motor  coils. 

The  coil  energization  information  is  derived  by  indexing  with  the  shaft  encoder  read¬ 
ing  in  to  a  phase  table  (one  each  for  forwards  and  backweirds  motion)  which  contains  the 
proper  coils  to  energize  to  move  in  the  desired  direction  from  the  current  position.  Note 
that  the  mechanical  coupling  of  the  shaft  encoder  to  the  motor  shaft  is  random,  so  for 
each  motor  there  is  a  shaft  encoder  offset  value  which  is  applied  before  indexing  in  to 
the  phase  table.  This  offset  is  determined  once  with  a  simple  program  which  energizes 
various  phases  and  reads  the  shaft  encoder.  The  values  are  then  hard  coded  in  to  the 
commutation  loop,  and  if  any  maintenance  is  every  performed  on  a  motor  which  requires 
removing  the  shaft  encoder,  the  offset  values  must  recomputed.  So  far,  we  have  only  had 
to  do  this  once. 

The  commutation  loop  was  originally  written  in  C,  and  took  about  300  microseconds 
to  process  all  four  motors.  It  was  then  recoded  in  to  functionally  equivalent  tightly  coded 
assembly  language,  reducing  the  execution  time  to  lOfis  and  leaving  more  time  for  other 
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processing,  which  the  more  complicated  servo  schemes  need. 

6  Conclusion 

Although  Uranus  had  a  very  long  gestation  period,  almost  five  years  from  conception  to 
actual  operation,  it  now  successfully  fulfills  its  purpose  as  a  highly  capable  generic  mobile 
base  for  robot  navigation  experimentation.  It  is  currently  outfitted  with  a  ring  of  24  sonar 
sensors,  with  which  it  can  build  two  dimensional  maps  of  its  environment.  Navigational 
computing  is  done  off  board  on  Apple  Macintosh-II  and  Sun  SparcStation  computers, 
communicating  over  a  serial  line,  for  easier  debugging  and  graphic  user  interfaces,  but 
it  is  anticipated  that  algorithms  developed  on  these  computers  will  be  easily  ported  to 
on  board  computers.  (Also,  technological  progress  will  soon  make  it  easy  to  place  these 
same  computers,  in  the  form  of  laptops  and  portables,  directly  on  board.) 

A  lot  was  learned  during  the  construction  of  Uranus,  and  if  we  were  to  start  over  to 
build  a  similar  vehicle,  we  would  make  several  changes.  For  one,  we  would  use  motors 
with  commercially  available  amplifiers  and  servo  controllers.  At  the  time  the  motors 
were  purchased,  nothing  of  the  sort  was  available  that  would  be  meet  our  power  and  size 
requirements,  but  this  is  no  longer  tme.  Developing  the  amplifiers,  control  algorithms, 
and  servo  controller  were  major  undertakings  that  we  would  not  like  to  repeat.  Also,  the 
mechanical  design  of  the  robot  is  too  tight,  making  it  difficult  to  add  new,  unanticipated 
(and  some  anticipated)  features,  and  hard  to  maintain.  Even  with  its  current  footprint, 
a  fair  amount  of  space  could  be  gained  by  making  the  middle  section  extend  over  the 
wheels  on  all  four  sides.  Maintainability  in  the  form  of  modularity  should  have  been 
designed  in  to  the  robot  from  the  beginning,  instead  of  added  later  when  it  proved  to 
be  a  big  problem.  Finally,  a  (literally)  weak  link  in  the  robot’s  design  is  the  drive  train. 
The  belts  we  used  were  not  nearly  as  strong  as  we  had  anticipated,  and  breakage  is  still 
occasionally  a  problem.  Using  something  like  timing  belts  or  actual  wire  link  chains 
would  be  stronger,  without  taking  up  much  more  room,  and  perhaps  even  a  direct  drive 
mechanism  would  be  possible. 
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